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(54) ROBOT DEVICE 

(57)Abstract: 

PROBLEM TO BE SOLVED: To automatically recognize overall structure 
and a motion characteristic of each constitutional unit by memorizing 
motion information required to mention a form and motion of the 
constitutional unit, memorizing characteristic information of an 
electronic part stored in the constitutional unit and detecting a 
connecting state of each of the constitutional units. 
SOLUTION: A CPU 10 automatically grasps overall constitution of a 
robot 1 such as to which part of a trunk part unit 2 and to which 
constitutional units 3A-3D, 5 it is connected and which constitutional 
units 4A-4D, 6 are connected to them in accordance with positional 
information of each of connecting points p1-p5 of an HUB 12 stored in a ESjRp^ i 
memory 13 of the trunk part unit 2. In the meantime, it drives an j m ^^ \ 

actuator and monitors it in accordance with motion information, ■■ " 

characteristic information, etc. respectively stored in the memory 16 of 
each of the constitutional units except for the trunk part unit 2. 
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(54) [»SU©£*fc] n^hifi 



(57) imm) 

ffi -T S *ftHJ *S i *RW S <fc 5 tc L c i k «t 

©fiiie^ . BS - -j h ©aib^tt * a wstfiic mm? 




ttH"*»i ©latest© £. 

JJBfllJSSa. - f h titfUir*ae&r {E&B&XrtflMlI 

*t atrr s jh 2 ©i att #s <t . 

*l BtST 4 JR 3 ©IBti#® i , 

[«I«JB2 ] ±KJ&KfiWBtt. 
jeofcW^Kfctt* 1 -3feLh©ffeCD±ia»^J--^ h i 

*<DMtmn®MM<D±Myam&v<D&m t ct 20 

> h ©* * 3 £ C i t -T HCIB3S 

©n#-> hug. 

C«^4 ] ±iB*^SP,S.©-hia!m4««« > 

±ias«ti#©*s^few v r t, > -5 6 n/c wttacc 

±iaw»#is*fi^ c r t» zm 0 ag©±sa#t ou- s» 
^fegtc^^- uri^is 1 ea©_hg5fltfiXo.^-^ h©_k 

i. 

*S£L.T(,>4* (L - 1 ) a@W^©±IB*fiS^-^ h 
*H (L+ 1 ) »a©±IBfllRRa-^ hi-TSi*, ± 40 

nsjjea* <l + 1 ) jsmcom^^y b<D±mwm 
nz&ttin mztem-r h% 2 <r>\*msw&fSL t -s 

*S£t««*<*ffl-r s c i -r si»*iM 1 tciais© so 
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*&g. 

^i-r-sw*ii8{cia*g©p^'-> hiig. 

s±tBg|5{i©-en^ti{ctt3i(CBif^©^ 1 ©tatta«* 
±ia 'j - «^©±&*> 6 tefr § n a m 2 ©tf m s« * 

±K» 1 RUW 2 CDtrftB** e 1 o©±|B^ 1 XttlS 

2 ©tf Kibs* mtRt zmiR^m t . 

±faa«?#©cc cfcoiitR^ n/c±ia» 1 2 ©tf n 

s#«:±ia-> y -«®©T{4-m^j-r?>m^#Ki, 

±IE*iR#!SHc «fc 9 n/cilBH 1 X«^2 ©tftt 
@«^i=.^B#£©tf . 
±K39W* j&©f Tlfcfc 6 . Mr&T -S ±!B«J& a 5> h £H 
itl3 tctb<DT ? ? J-x - {Ct&fp^^^i ^ 

Si. 

itmm 1 1 ] £f**iwu-r zm®mmt . ^ < i & 
m-f i> vmm -? a 9 r> a cc «t -o r ^at>±f b&*t-§i$.&© 

h=£g„ 

CI#*]Sl 2] _hfB^«fiK3.x^ h©±ta^iats^© 

«. 

< i 4>^-r?,±iamT-gp t a©itttt»fR^*-rT ; " 
^r©±ia*^-g|5 a [ !,tc>ptL-t:*ji<t3n. *» 
o^>^< i 4>±iam^-si!p a n ©^tttf#R>£*-r±fa^-^ 

tict tts m*m 1 1 iciew© a #y t m 
g 0 
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as t>*±t2tf mmta om^a^^A^m^ta-rt^c^ 
±iait mmm omy'n ^cm^x^s^- zm~& 
&^mu ±iai£i ©-/p^Atca-ov-c. 
ga^*-7-gi5 l acDtitg«tcifcatc^;* e, titcmmco =f- % 
7^-v7hti3n^i©f-f^. iias^-f-gp 

Of- £ tcSKft L, 2 O f - * KI6 o fc*RSHt# 

^r±tas^gi5p a a cc^m-r * c <t cc j; o ±ia* j ?-gp n a n cDi6 
ft*iw®T* c & *ra«i-rai»3joH i 2 ccfat&©p*' 

MSB,, 

&mf&3.~y h ©iisb^iaaiT-sojc^^astitffR* 

*S 1 1 (cia*S©n*'-> 

[f6BJ©3Mffl&iftBJ] 
[0 0 0 1] 

[0002] &w<Dm-rz&.ffiftw} 

#69J©»6©^!g 

(1) SlISttOT (HI -06) 

(2) jft2ggtfc0| (H7-vHl 0) 

o) m3mmm mi imsi 2) 

(4) ffeO^W (HI -01 3) 
[0 00 3 ] 

tc aj: 3 n/c n # h sigtcjiffl t, -r»j&& & ©-e * s „ 

[0 00 4 ] 

[^*©J$#t] fife*. B^F©^<B, IMftSB, fltpgG 
[0 0 0 5 ] C<Dm-£ifrfr2>ffim<DU^:> Hi. CPU 

[0 00 6 ] ctuc^fu-c. a^, #(;u;mi?sw 5-2457 
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84^fgic^snri^J:^tc, ^©Mfs-t^a- 

^©T-A^r^a-JUi^fi^tJ-tf-SCiCC 

<k <o mmmmc mm 0 n s £ -5 cc a 3 n/c p * w v tarn 

Z.htlXh>&, 
[0 00 7] C©»^-#gg^-5-245784#^ffi{Cga^§n 

;ui©ra©®fftcj:0f#6n^Mi5*^^-Ji'©EIW# 
#{ca-3t,ir#BI®*y3.-^©^jiB#*^L, 12 

10 m^mcm^xmmv'u a*0 &©«:»#& 

[0 00 8 ] CnJCtO C©PsK7 h{C*Jl,^T». P#' 

hzmfr&xzmw'mmmicisvzvy 1^x7(1 

*&©— ii©f£ff; (FiRCi7'a^7A©xf :: '('-> h. n> 
[0 0 0 9] 

20 ^~>i<Dmmmm*mmw-s?icm'3^xwm-fzj:5 cc 

[0010] *fc±a©WP|iF5-245784#&«-CB. "7 
245784#^*(Cg3^$nfcrt^f/cW-C«1tJSa^^ h £ 

30 [ooi l] c c-c«A«a8»©«W53.^^ h*>6«« 
3n^>P^-> htcfc-cjr, h©ii>^Hj?)$iJ 

§S-b>1J-^£©g|5 0 a n ^i c (Cl3g$ ft. $7ti'©<fc ^ 

^CCBJtf#TSC<!:Ai-C#ft(i. ffi^©«^^.--> 1-^2 
ilH±<tCfri£LXm&$titcm£fP, W8L3--'y v&m 

wwaw e »w cc^jtr s ^"p y ^ a *fpjfaE u# * «fc 5 

JC-T S C i &X * 5 » . m tct£ffiM<D 1 ©fl|^«: 
40 •£*»£&©£#;?. 6ft S. 

[0012] *^Sili(±©.^*#SLr^3ftfcfe© 

f, ffi^©^3.^--> h^2o«±:c^iKbrM^3ft 

/•cJS-&(Cfe®ffl"C*5, ff7cfeffJ,1M©P^'-> h©«^% 
[0013] 

50 *yt*©»«NMR*Ktt-r4*l©iaft*Si. MteSa 



5 

[0014] ctiteJ: fcffl#®(c«fcStft 

[0015] ^/c^B^Cfcory:. Ptfy h§§ffi£fli 
RJW**«J«ar.^ Ko*Ett#««:. tl*?$t*s4H* 

tc J: or : PA*«^-»,HW)«Wft#tc*a«:^j& 6 W»f 
fOf-^^^-v^hTiShSSlCDf-**. S 

ssr 2 © 7 s - £ tcsaft-r 7* a y 9 a £getg 3 # § 

[0016] c©*SSW»ffl^py^A(c«fcor^««>^ 

V h%RW-rSCiASr*-5 0 
[0017] 

[fSBJ9©^«S©J&lU Jjrrasicoor, *%b^©— n 

[0018] ( 1 ) m 1 3ISfi« 
HI K*JOT v ltt£f*£brmSlJfeWtcfcSPtf'> 

r 2 ©ffi^*a$ic#SB:x :=.»;/ h V h 6 

Sficcaz *y # » 6 tir t, » * . 

[0019] C©*I^IW*»ai!y r 2©F*J»CW:. 0 
2 iCSrf J: *> (c . a V l £&©«rfl££iM$|lT -5 C P 
U (Central Processing Unit ) 1 0, f^Mi©^ 'j T JU 
AX4flT4SBH (Serial Bus Host ) 11. HU 

b i 2S^*y i 3 3WDUft§tirc»*. -e 

ur^^&>; i 3ic«, mwu3-~-y v 2oiii^s3^© 

T. cn6**i»rawM«RiDfA) £. hub 12 
©*a»^ p 1 ~ p 5 ©fiattiR 4 & a^-e-n-entgw 
§ftro&. 

[0 02 0 ] -^Mf*SRJ--^ h 2 S*tJj3c:x~ ? 

h3A~3D, 4A-4D, 5, 6©rtSB(C«, -eft-?* 
tiHUBl 4i. T £ ^ J-x- 4?Rc>*-fe>^©SS^gp 

■ai 5 jtfj i e ij&ufcswsnos. -eurcne 

iS-ffcEfc-^-— 7 1 3A~3 D, 4A-4D, 5, 6 <D&J 
^•;16{C5J, *ft6"r*«lfci-^ h 3A-3D, 4 A 

~4D. 5, 6 mmmmmfmmunt , ^wm* 

-7F3A-3D, 4A-4D. 5, 6 rttClRWStt/c 
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[0021] $ hicmwn^-v v 2 ©h u b 1 2 sc 

f*. *§|5^- 7 r 5 RCX**«a5ai -y h 3 A - 3 D © 
HUB1 4*M EEE (Jhe Institute of Electrical a 
nd Electronics Engineers ,Inc) 1 3 9 4XIJUSB 
(Universal Serial Bus) ^©Sx UT'WU 1 7 &ftL 

S|5:3.--> r 3 A~3 D©HUB 1 4{C«. •eft-eftPH 
©•>';7^U 1 7*^-Urg|g|5^-^ h 6 ©HUB 1 
10 4X(**tl£-r-S-r*ag|3^-^ h4A~4D©HUB 1 4 

[0022] cntcjrocon*'^ h i r«> cpui 

0#SBH 1 1MHUB 1 2 t&HH&3.-V h3A- 
3D. 4A-4D. 5. BOHUB 1 4<b*K&tL 
t, Ctl6§i^'>h3A-3D, 4A~4D. 
5. 6©^*y 1 6 36»6S»y*y 1 6(of#jW$ti/c& 
ilWRtI!*ffll. S»fc-7h3A-3D, 4A- 

4D. 5, B<DTf^^x.-^icmmmm^mL, x 

»S^)?S^--=-^ h 3 A~3 D. 4A~4D. 5, 6©-fe 

[0023]^tC©P#7Hm CPU 10 
IWfcgIS:!- •> h 2 ©^ •=& y 1 3 iCtm 3 tl/cH U B 

1 2 ©saafes pi-p5 (D(i&mm t . ura^gp^.- ^ 

h 2 £&£<#4ff&;x h 3 A~3 D. 4A-4D, 
«-3(,>r . «i*S|5^.^ h 2 © <B©g|5^(C £■ ©J: ^ A«c« 

a^->h3A-3D. 5*w^3h. mtctomm^- 

-7f-3 A~3D, 5CC4©J:^J&*fi)?^^ h4A- 
4D, Q ZftXi*&-frt^-otcU#-y h l^ft:© 

30 »^?:gKlW(CjE2SLff?>-77, h 2 

<#^a^-> h 3 A-3 D. 4A-4D. 5. 6©^ 

*y i 6(c-en-ents,^$nfcji«)t»$iiRL>'!m4t»iR^ 

(cS^I,>r3rM©«^-7h3A-3D, 4A-4 
D, 5. 6rt©Ti'5 1 J.x-^^|BSil$li'-5CiK:ct:D 
^mmm^-^-y h 3 A — 3 D, 4A-4D. 5, 6 5rBl? 
Mtt^(C.|gS&b. *-5C©t*©CO«^->h3A 
-3D, 4A-4D. 5. 6 ©tt»*S»Pf*SRa-^ h 
3A-3D, 4A-4D, 5, 6 rt©-fe>-y-©tH^4CS 

o^r-^-^^-sci^r^^cfc^coisnrt^. 

40 [002 4] CCrXKl. S«a--n3A-3 
D, 4A-4D, 5, 64 A©y*y 1 6tC«, 
^•tDT€>^g|5 D D a l 5 5 Ti'f ii-^f ©#tt 

fffRiUr, ^fgT^?-^x-^©^'C7' (M»MX(i 
IUIe^) «\ rieiiEfta^ i C ] mi ■5»#ccttio/s 
;bx^©/N-^xff^r^5MWf^^Sr*5j in 
^ <t ^ &t»«*stSiW s nr os, 

[0 0 2 5 ] ^UCPU 1 0«, SJlfpB#, C©«fc5tt 
WfR^SIf^x^ h 3 A~3 D, 4A~4D. 5. 6 

so or, w*«i c* J ii^ftffi^-^^io/t^^© 
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[0 0 2 6] 1t*$C<DmiM<0m&s CPUlOtt, £ 
(Dfffiar^h2, 3A-3D, 5, 6CC 

<!fOflteg3.x^ h 2 v 3A-3D, 5. 6 

SfttUS^ito /cft« OcS^l > r , HI 3 &C?n 
T<fc^ttS«fiS^-^ h2, 3A-3D, 4A-4D, 
5, 6FI©^Citl,7»;-^M0 4 C*l£ISI4iC 

[0 0 2 7] JfcC0Safc«(D«^ CPU 1 OB, S 
«^£^^^h2 v 3A-3D, 4A-4D, 5, 6<D# 

A-3D, 4A-4D, 5, 6 (Dffifttim&mttmiC 
[0 0 2 8 ] CCtCPU 1 0CCJ:4n#^ h 1 OffJSfJ 

[0029] JTCPUIO^ X^T'SPUOo 
#y h 1 ©»JI»&ffi*H»&U Xf^7'S P 2CCtet,> 
r v ±fl$8B:z-=.y h 3 AW^y 1 6*^-&«t»|R*K 

«&ffio/cf£, M<x^^^sP3cc*>^r, i^mo/c 

4 y' (actuator type ) *#J»fU 

tcti % X7 u ^^SP4fciitf 0 

[0 03 0 ]^ltCPU10tt, C©Xf77-SP4 
fCteOT, B^O^flEr 1 -* (angle ) 43£j1j1»JCD^ 
SftSBSK (length) CCSEffcbfcSL Xf77*S P 5 CC*C» 
TS»E»ttlBli (length) tC|£C5tW»m#«:*fl8»a 
1-3 ACDT^*:xx~£fc:j£tHU Xf^7 4 SP6 

[0 0 3 I ] — KPU1 0«, Xf77'SP3^ 

r, *B8SU^— ^ h 3 Aor^jxx-^j&iHKfflT* 

(angle ) CCJS0fc*(lt»fi#**<D3f 

[0032] &.±<D%immmz. immm^-v v 3 b 

-3D, 4A-4D, 5, 6 fcoivc t>lsl«r#>& 0 

[oo33]cc-c^±, o^nnc^m c 

PUlOte, §ii$a^7h3A-3D, 4A-4D, 
5, 6&m{#gH3~~y h 2tC*S^Stifci*CCS«^- 
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u>r ncfcc^rcpu 1 o«, cwsiWiiwiia-^ 

h2fctt^3nte«©*»«a^^ F3A-3D, 4 A 

Co 0 3 4] «±©«j«K*5C*r, tKDP^nir 

CPU 10^ h2> 3A-3D, 4 

a-4d, 5, 6(Dy*y i3, i 6cc^n-ents*fls 

n/c§»i)S^^7h2, 3A-3D, 4A-4D, 

^T±fo<Dmmzmmu, ^mrn^y h 2, 3A-3 

D, 4A-4D, 5, 6CDtfrf / F*$fJg|I-r'S 0 
[0 0 3 5] ffiotC<DP5K7 r ltU b 
2, 3A-3D, 4A-4D, 5, 6 (Dffl#£*>tMC<fc 
6T\ CPU 1 OjWSTCCPsK*;/ r 1 ^f*CD# B5rfEg 
U Stf^^^h2, 3A-3D, 4A-4D, 5, 

6 <D«rf^*ww-r * C * 
[0 0 3 6 ] ccro^ h(Dr7-p^^5>ytcocir 

2o^-x^^ a — #«a^7 htX»t4^P 

»orc*s»^r*«3, M0@Ma#7 hft^cD^ 

— tf*ip^ hoM^^7 h*escc«^a*cc 

[0 0 3 7 ] S6{C^^A*iattWCCK»0fcP^> 
h (^-^^P^y h) <D£<D%ffi-i>m%H-c, <t*<z>S5 

^tjwsBr, a ir©«i*#w*tf 5 *> 2 a 9 

[0 0 3 8 ] C<Dit^S»#^*ff 9 
06 (A) tc^T<fc5&>oi<- ^ y> ha*7 h (»tf- 

S^KH-Ufc-r-^lfjfiCOn*^ h) 1 8(D<ir<D8BfiMC 

ffi4tSSt#**-^*S 0 06 (A) -Ctt, B107>/^ 
^Ptf^h (^Ptf'^h) l©S^'7h5, 6^^ 
40 > Fa^7 h 1 8om%$. Mf&3-~v b3A, 

4A*ceW«fflJ % h 3 B, 4 B^2EBuPgR, 

flteSa^^hSC. 4C«*a»W» % «tta^^h3 
D, 4D3Wft»»aJ, «JS^^h3A, 4 A, 3B, 
4B^fuJWS|5, iffia^7h3C, 4C, 3D, 4D* 

m KS*WSU* S 6 OCJISP^x r.7F4C RC^*flaapa 
h3C<DJ:5«:#««5^^ h3 A-3D, 4A- 
4D, 5, 6CC*«4f*WSCi*>pJ»B-C** B 
[0 0 3 9] C CtP^ htD^P ^7 ^>^CO^t 
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^ y h i on rtf $B(D^ u <h 0 *tf 5 c t as v # £ 0 
[0040] — Jjutfy W^u*/? 5 >y&coi>rf£ 

[0 04 1] l^l/ttJWfc^— ^+JUP#fy r<D«f$R% 
^ -ftiS* 6 A- v ^ ^ > fc* ^Of" -Y X V' 

[0 04 2] g^OT, C<Dtr-X<Dm£t («b^C© 
£±<DGU I (Graphical User Interface ) 

fcT-U RtHfti^n*— :/y > r P#U> h*^-v^;l/ 
[0 04 3] *fcC<E>-5r~XO«£\ ^C^-V^Jl/n 

i»SHa±rS«fiSa-^ hi©»Rtt«*fit^ Hit 

[0 04 4] «±<DflteRK: Jrfttf, r 2 . 

3A-3D, 4A-4D, 5 V 6 rt»fc*ft-eh!3Rfl| 
^^•>h2, 3 A- 3D, 4A-4D, 5, 6 (DJ^tK 

tnn&&mwimmm&mR$titcj**:v 13, 1 6^ir 

*frr*<hftK:, CPU10^Mar.^h2, 3A- 
3D, 4A-4D, 5, 60y*yi3, 16CC-€-*i-e 

&CL/cC£CC<£D, «^^^h2, 3A-3D, 4A 
-4D, 5, 6<0*SAtt«CC<t6 , rCPU 1 O&Utfy 
h 1 £#Ofltii£}e«U ^Slfc^ 4 ; r 2 , 3 A 
-3D, 4A-4D, 5, G&mmtWTZCt&V 
^ *< L/Tffi*(D»^^.^ h#2ojy±f«MSl/T 

[0 0 4 5] (2) iff2^Jfct*J 

[0 04 6] C<D«^te x H7(DJ:^3&««6^n^^CC 
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fl)S«*^S±tt©^O^A'C*^ MoNet 3 1 

[0 047] MoNet 3 1 fr^OmMZ, #57&m<DND 
de (mm, ST l-ST4<DH#J?^'Jr*<3, Cft 

6NodeST 1 -ST4Ps1<DEdge (S5»SffcOfcfeO^P 
^ A ) E 1 - E 6 Ort»^W»R^|^*0»«teR» 
10 &(DTtm**-Z (feTF, ^r-^i-TS) *jW«W5 
7'P^7A«jnrt^ 0 MCG (Motor Command 
Generator ) 3 2 (0 7) « % C CD^'p ^ 

[0 0 4 8 ] C cr»2HJ6«ltt, P#-> h^ft/cWt 

[0049] 09 $C 2 o<D*8B, 2 ocdWSBRVSRBB 4 
*W-r**2*«W«:<tSP#^ h4 0©*«*^t Q 
C<Dm^m 1 IQ^r^fflWCCJHtfffljL^^ h 2^6 

n$g$3L~y h 3 A- 3 DR&lrto$&a~y F4A-4 D 
30 ^6ttS4*CD|^4*5«4l3nri»fc*«, CCD09 53: 
^n^r^JIW^CJH^g|54 1 CC^g|54 2 , WS|54 3 ROW 
fflJ4 4^Stt3n, S6CC^SB4 2R^WSB4 3(D**i 
^tllCt)&ZF&<Dffif&$$4 2 A, 4 2B, 4 3 A, 4 3 

[0 0 5 0] HI OCCH9 5C*$WSSfltflES54 2, 4 

3, 42 A, 42B, 43 A, 4 3 BOSrtBfcSVT. S 
7ira«CC, »^SP4 2Sia sr 4 3«, ^Fvh>30 
A, MoNet 3 1 ASt^MC G 3 2 A*»6tt 9 , fl»^c«B4 
2A, 42B, 43A, 4 3BBt- hvF>3 0B, 

40 MoNet 3 1 BSyMCG3 2B*6&4. 

[0 0 5 1 ] 3fc«0, ^«^§P4 2. 43, 4 2 A, 4 
2B, 4 3 A, 4 3BCCfc^rS^O«flE»4 1-4 

4, 4 2 A, 4 2B, 4 3 A. 4 3Brtt»SLfcM 

lCDCompSOA, 5 1 ASO'^2(DComp5 0 B, 51 B 

[0 0 5 2 ] C©ta^73Wg»<D«ffi<DMDNet 3 1 A, 3 
1BXBMCG3 2A, 3 2 B CCA#3fl£ iB^FfC, 
50 B^OS«5'r35:S*tl«;-r*aJtt4 2A, 4 2B, 4 3 
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[0 0 5 3 ] ccr— MWfcefffflPtfy Kelt, sst 
Wtttftti, i*iB*3^wr»liiS*fcr4<t5«cfftt4* 

[0 05 4 ] H9C0cfc 50C«tt&fc-ofcO#y h 4 00 

iMi*iSfc^ y -HKS^flg ^ y ^ h*, cnccs*-rs 

S*.r**o rtt*>%^y-*Jfi©T©S (LiqhtHand, 
LeftHand&i*) ^tt^ft±£>t$ (Hands ,Body£c£) 10 

[0 0 5 5 ] «±<o««tcj:ntf, tt«<o«j«3.-^ h 
* 2 •o«±«:^tt urgtt^ c t cc <£ 9 e> *i 
€>p^'^ Meteor, F^tneftccfif&tt 

[0 0 5 6 ] (3) m3^»j 

U10^#M^^F3A-3D, 4A-4D, 5, 

7A4?a)Si^a-7h3A^3D, 4A-4D, 
5, 60*^'J6 1 (HI 1 ) rtCcKttSttrt,**. 

[0057] rt£fr%m2 ±<D>$m$mtcm— 

ItStH 1 HCfcUT, §tea-7h3A-3D, 
4A-4D, 5. 6<£>S^*=ty 6 1 CCK V ^nftlW 
ffi^7h3A-3D 4 4A-4D, 5, 6 <7>JF£Kt» 

[0 0 5 8] f^fcSSR^ffiTfcftcD^ F«, 
*««i-^h3A^3D, 4A-4D, 5, 6 

•^y 6 1 ^6K^tt}$n/c^^>>x^ h&hf-zwM 

*»#ffl-Tfce&<DfcCDT*9, ^-TCDfit^r.^ F 3 A 
-3D, 4A-4D, 5, 6CC#0r#«fl;3*iTtr» 
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^ ^ y 6 1 ceff X(DM#(cett s**ci#sr**<t 

[0 0 5 9 ] tft^D^Ait MWB^V h 6 2fc 
fci^nri^CPU 6 3#*flWJa.=.y F 2, 3A- 
3D, 4A-4D, 5, 6 **|»T*fcftfcffll>*:/a 

*-fgPn D Dl 5CD«fgi0rr^^^X^^<DiS^, £© 

*g/$:x— ;/ F&c#ur4>T*^:x:n-#cc#*4^-# 

^ficwatBtfccaioriJi) * % &n^q a a i5# 

%*^gBiFa 1 5 <Dt£#g«) V V F A^R^StiSo 
[0 0 6 0 ] SfotM^7 h 3 A-3 D, 4A- 
4D, 5, 6CD^m^g|5p a pl S^r^-r-S^CD^ (-T 

ato^w^F-aPn^ 1 5 <ommk) & 1 ^©w&ccra:, ^g* 

^7h3A-3D, 4A-4D, 5, 6 Sftft 1 
5^*aT6SR D n a <D^^(7)JS^c^ v Sjft^ay^ 

[006I] se^r^x.«m^ D a a 1 5*>*y^*:xx- 
^-if^ffifflsnri^r^^^x-^^r f* 

[0062] -rttfe^iswgfta*fBers^v!y f <w 

Tvoid set Anqle(Anqle Data& angle) ; J ) £ 

[0 0 6 3] CCrCPU83tt, SOteJEa^.^ h 3 A 
-3D, 4A-4D, 5, 6 ifimtf$l&~ V h 6 2 CCift 

7h3A-3D, 4A-4D, 5, 6^^*116 1^ 
e^y^x^ h*R*ttL/rcn«rlH*»^-^ h6 2 

^h3A-3D, 4A-4D, 5, 6«C*flSLfc*^ 
hCCS^orS«/^a^^ h 3 A-3 D, 4A-4 
D, 5, 6Ott^SrftlJ8SJT&J:0(CftSnri^ 8 
[0 0 6 4] CCrCPU6 3KJ;5o^ F 1 CD*lJfflI 



13 

[0 0 6 5] *fCPU63«, Xf^7 4 S PU^a 
(ob.iect) £R<^£ttLfcf£, Xf^^S P 3 CCbUT , 

(proper value) ) tC^T£ 0 

[0 0 6 6 ]^t?CPU63(t Xf^7 , SP4(Cij 
1>T, CCDMmtem (proper value) CCtfc G fcrMMi# 
*VXfA;U 1 7l:/rir«^7 h 3 A&Cj£ffl-r 
SCifCj:^ h3 AOttft^fflffllU Xf 

^•7*S P BGtte^TPtfry b 1 CDtWMII^^TT^. 

t 0 0 6 7 ] jy_h(DMS^JB«, mm*-? h3B-3 

[0 0 6 8 ] CCtO^; r 1 tete^TK, CPU6 3 
te. §H^a-7F3A, 3B, 3C, 3D, 4 A, 4 
B, 4C, 4D, 5, 6*J|B»»a^^h6 2CC|fr^3 
n/ci # $C:*:/^x£ h (ob.iect) ODKtHL* 1 Mtcii 

S«^^7h3A, 3B, 3C, 3D, 4A, 4B, 
4C, 4D, 5, 6CDT^ax~£ra^<Z)£^ 5 > 

[0 0 6 9 ] M±L<Dffij&l,Ci$i<>X . COP^Ht 
S-flt^S^x^ h 3 A-3 D. 4A-4D, 5, 6 <D 

hxmztLzm 1 of-^^, §M^7h3A- 

3D, 4A-4D, 5, 6 ®«*?«A 1 5 ftHMBffCC 
ffl^&f 5 -*:?*-^;/ bxm$tl&m2<DT : ~Zt<C^ 
8S3ft£<D~C\ Wmm^Wy Mc&ix^tbVktbhft 
tcf~%y*-~?y Kc&fftt-rcc, §«^^7 h 3 
A-3D, 4A-4D, 5, 6 *mi~?& C ti$X% 

[0 0 7 0 ] Tttt>feCCD»3Hifi«(DJ»^, 

h 3 AKftlxm<om&<Dmiita-y b 3 AX 
5r«^ji7h6 2iC^3ti:t^ co»-7 h 
3 AX«a^7 h 6 2CC*S^$ti:/c<h#, 
S> h 3AX^^'J 6 1 X*6CPU6 3 ic^^^x^ 

b&tf^ya- b*$ti&<DX, CPU6 3»*)S^7 
h 3 Axw*y 6 i tc«nwsnfc»jKt»«, «Krf#« 

*>, co^^x^ bic^&ti&m&y&y^Mcm-j 
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^xmm^-v b 3 Axomttrnm-rz c t&x% 

So 

[0 0 7 1 ] «OT»fifcx.=.y h 3A-3 D. 4A-4 
D, 5, 6(DtB:8t#« k **«^F3A^3D, 4 

a-4D, 5, etc^-n-enifs^o^i^-^^ffifflu 

f#S<fc5*C«/£:zxy r 3 A-3 D, 4A-4D, 5, 

sit mc tsvz fm<omm s * *«c fiis^ci^ 

[0072] «±o«rscc <fc*i«, a»ti#K 
atfWFttflwiss-r^-irfliJSi, £r<D«j^xxy r 

3A-3D, 4A-4D, 5, 6 <D&tt«iff a l 5 iC*f 

sbSS-T-spfa i 5 cc*atc^«>6 n/cf- * ^ 

r <t UtSSlEax^ h 3 A-3 D, 4A-4D, 5& 
0*6 6 lrtCC^»Ett3«T45#, 

-7F3A-3D, 4A-4D, 5, 6 *IHf*SP^x-; 
h 6 2«S^$#/c<h£^ CPU6 3^i^^ 
h3A-3D, 4A-4D, 5, 6^^'J6 1^(3 

n^^ACc^or^^ft^tifcf-dr^*-^^ hie 
ffiSWtC, §Max^F3A-3D, 4A-4D, 

[0 0 7 3 ] * /c±acD#^^c J:ti« . »<W*«*R* 

[0 0 7 4 ] 3 6{c±aco«|j5SccJ:ti«, S»^n^7 

40 Sax7h3A-3D, 4A-4D, 5\ 6 6{*-&(D& 
04^IWC. i^7h3A-3D, 5, 6CD«J 
ffflgf^SI ^C^M 3 •& £ C i ^ # 5 . 
[0 0 7 5 ] (4) fteOHJSM 
Kte±m<Dm i HHWccteCir«, S«^c^x^ h 2 , 

3A-3D, 4A-4D, 5, 6 CD|*J Iff (C* CD 
fl|^j3LX!Vh2, 3A^3D, 4A-4D, 5. 6(Df 

«tWR, ««&«$RR^#ttttffi^m«3n/c^^y i 
3, i 6 4K^TSct ^tco/c^cco^ras^/c*^ 

so ZmZttLtcmi 3fcjjk*?£>?(<c, &ftf&*~y h2. 
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3A-3D, 4A-4D, 5, 6©^*'J7 1, 7 2tC 
«^S^fllAS^- V Y 2 . 3A~3D, 4A~4D. 5, 

© 4 g& n a D #-^ 4 t,c Mfc 3 r * ©«*£ a ~ 

5^2. 3 A- 3D, 4AMD, 5, 6 ©JFMKtffg, 

Mtmmtvmsmmmmmz ntcs * y 7 3 cx« 
ffi©ie«#a) %«ifrajjLi^ h 7 4©rtsi5{cf&tt, c 

&tfH8t^~y\-2, 3A~3D, 4A-4D, 5. 6 CD 

[0 07 6] $fc±^com 1 JISSWcJaOTtt. &fltfi£ 
i-^h2, 3A-3D, 4A-4D, 5. 6©ff5ttf* 

^*yi3, i ezmm-? ZxZ'hcl tcm&ic-o^xxE 
*<itj)\ ^mactiicm^-r, c©fl&« *©tat83M8 

SrSJBTSC 4 C©i»-&&t!teS:z-y h 2 . 

3A-3D, 4A-4D, 5, 6 ©flMKf»*E, SifrtKffR 
SCfWttW*© *> %© 1 oXti^gP^S'J^ ©f2tf*S«C 

[0 07 7 ] 3 6«C±jaS©HW«{c*j(,»-r«. 
~->h2, 3A-3D, 4A^4D, 5, 6©^*U1 
3. 1 6CC«|ft-J-S3tt|«JSir.^ h 2. 3 A- 3D, 
4A-4D, 5. 6©MKtf#B^iPI^g3^T?&-2>*»l=f 

i"^h2, 3A-3D, 4A-4D. 5, 6CC*tUT 

±©f6©#fiRa-^ h 2, 3A-3D, 4A~~4D. 
5, 6 4*S^3ft£)S§^r©*§i^<ig4, ISSRHtefcx 
~;>F2, 3A-3D, 4A-4D, 5, 61>m$£T& 

[0 07 8 ] ra«(C. *»«a-«7h2. 3A-3D, 
4A-4D, 5, 6(W*';i3, 1 6 tCt&jJft-T 

h2. 3A-3D, 4A-4D, 5, 6<DM 
9hffiW.<t OX, mi&3.-Vb2. 3A-3D, 4A-4 

d, 5, 6icttLxmm(Dmmm%.z?&m$tizm7£Ltc 
m^icisi-f^msm^-cco^omm^'y f 2 , 3 a 

— 3D, 4A-4D, 5, 6 ©MJSM-DO&gi , i^te 
81^-^2. 3A-3D, 4A-4D, 5, 6©Sf 
li, att^'>h2, 3A~3D, 4A-4D, 
5, 6©Hte*-^> h©*#3 4£^t?j: 5fct,Tfc 

[0 0 7 9 ] 5 6tC±a©» 1 Rtff^HSfcWcte^T 
«, &fltfiX^.-^F2 > 3 A- 3D, 4A-4D, 5, 
6©tt^tt«*«kU-j-S«ffl*©*CPU 10 4. 
t'H3, 1 6 4, i/TJWU 1 7 4i&4t?fl|fiSt--5 
Jr^JcL/JttB^tc-o^r^te*^ ;£#S9JfcJ:cft{cPR6 
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[0 0 8 0] $ 6CC±i£©3ii 1 &t?»23IS6Wc;te<,vr 
tt, CPU 1 0*5, *HHSa-'y h2, 3A-3D, 4 

A-4D, 5, 6©&^>;i3, i enc&mztitc^ 

*mf&3~-V h 2. 3A~3D, 4A-4D, 5, 6© 
0, ^*©«**IWEr.5J:^{CLfc«^tcoi>raS' > < 

fc#s, *^Bj«cntci5i6-r', mtfcpu 10*5, •§ 

flfj&jz- h 2 . 3A-3D, 4A-4D, 5, 6 ©fe 

io ittlk 

[0 0 8 1 ] 3 6tc±Mi©Sfl2*5&W£:*J<,>T». n*' 
f h©#«fiSSB4 2, 43, 4 2A, 42B. 43A, 
4 3 BOll^il 0©J:5{C-r£<£Mt0fcJa^{CO 

ri-3«±©»(a*i«Btrsafta*®i. s-swao-tn 
^tuci&iLicffifeom i ©fftta*R*«^3-a-se«#6 
3^13 4 , y y -«a©±fib6> hwj 3 ft s » 2 ©tf n 

6 i o©m i x«^2 (onwimm^miRt smm^m 
4, aai?#©(cj:i3aji?3nA:*ixBa»2©tf«ia« 
*^y-«js©Tfit^u^j-r4tB**Ki. miR^mc 

£ <0 MtR 3 ftfcld 1 X«J* 2 ©tf«fr@*5^6^^©tf 
■fr*f&£3tt.5»£*R4. JlB#*©|fKl*^. *fj£T 
f&;x.=. •> F£8M&3tt£fc&©T:7^:i:E.-Mtiii 

[0 08 2] 3 6{C±j$©»33l»SWC*i^T«, ff5t#C 
i?x^ h^67 ::: -^«3S^*l±l-r/!:*©^v^ F 

4. mmmy'n ^^x^mkithtiftffij&D^ 

-•>h3A~3D, 4A-4D. 5, 6©#^g|5 a a a l 
Lt^a-^(-3A-3D, 4A-4D, 5, 6©# 

y * y e l rtKwett3-er*a>fc»£Koc»'rjfc'* 

40 T^^ZJ.i-$SJ>*-fe>-y-^CD^S^^g|5 0 a n l 5*I)X 

St i 5<Dmnmm^m-rr-^m^t, t^yi? 

n^^AKJ: otffefti* 6 ft fcBf^© 7 s - £ 7 * - v 

^h-castis&fje©? 5 -**. iwfcas^-y h2©s 

ft 6 f 5 - ^ (c^»t-r Z> tcth<r>m% 7'oi/7AiWy 
h4L/r^*^*y l 3F^5c^fI3#r*s*, 

y 1 3W^COt^yxi> h^fflLt, 
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C 0 0 8 3 ] C C "CC P U 6 3 «, P*'^ h 1 iCMM^ 
&A 3 tltc t £ . X«m*aJa ~ y h 6 2 (C*S^ 3 tltc 
fltl&ZL-y h3A> 3B. 3C. 3D. 4A. 4B. 4 
C. 4D, 5, 6©5*i, t>m36» 1 oX««»X«^ 

fl|f{#gtf;xxy h 6 2©y*>; 1 3*>6*7'^xi' 
[0 0 8 4 ] S 6{C±aSO#3 ^J6W«C*j(,»"CB. Tfctfc 

t=- *«jt*«*wrfc«>cDjf v y F £. tfflfflyp y 
=y Ate J:-?r^es6^^|5 a a n l 5 otRJfe&tcAaccifeb 
6ftfcF^5£©ir-~y ?:t--?y K'iSnsf l(Df- 

y KT**3*i£fl?2©^-y(C^&-r-5^&ypyyA 
i^^y^xy hi VT&mi&3~-V b3 A~3 D. 4 
A-4D, 5, 6©«-y^e<; 6 1 iCiBttSti'fc.ti^CO 

^©iSi^tti^^'-"^®, yyy KRD^&ya y 

7A^Sffia-7!-3A-3D, 4A-4D, 5. 6 20 
Ogy*U 6 1 {cettStfTfcjao. 
[0 0 8 5 ] 

^~ y f- ©jBtt*8ue-r & tabmrnmnzmm? s * 

g&SMfrttMa&iati-r -sm 2 ©satt^&i , tgj&^y 
h (cnxtt 3 ti/c«-^gi5n a n ©^tttf **iatrr &m 3 ©ia 

y h ©a»#tt?r a trntcvem-r scim, < 0 

[0 08 6 ] itc^miC^tlit. P*y h^g^fS 
tSftlSSai-j KO&Rtim&it* Sfjffl)#ja*i&fl|^ 

^~y h ^fijwrs/ctoic^ffl-rs^Wfflypy^Ajc 
jz^x^ib&'m^mffaCDMmmi.c jmicvktb btitcmm 
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£ K <fc «3 , Mfllffl y"p if^AHCj: or ^«>&£> htitc? 

r s BuoHft© e ss^tsiswtc ft_h 3 # * c <t ©t? * 

[a®©fB*«:SSW] 

[01 ] snnjSfc#i©p#'y h©«tes*^-r««iiar* 

So 

[ h 2 ] * 1 H]ifeW© o*-n ©tt^^r^-r y p y y 0 
[03 ] sfltesa-y Kott^tcmiray y -ts>g£^ 
[04] mfa??7<Dr-~zm&zjrs-?B&mmv$)6<, 

[05] »lHS6WC*iWSCPU(C«tSP#y f-©f|H| 

[06] A-ft^a^ b<D&mtiLtc*rrz>m.mttt 

[07] asKy h^flsKe»tt*fefc-&Sfc»©««y 

pyy^i&^-riSitgsr**. 

[08] MoNet <Dtf^7ffi&Z:m-$-mUmX'&?>„ 
[09] Sit2HS6WC<i:SP#y hO«39:Wa:#JSR%^ 

[010] &«B£a5©«|jm©iiW{C«-r58t±0-C* 

[011] Sfl33eiftWcJ:£atfy hOSISi^t^a 
yy0-c&£o 

[012] Jfl3 JUtsWcfow-SC PUKi-SP^y h© 

[013] ffc©nj6mm-rypyy0t?*-5„ 

[#-*f©t£W] 

1 PxKyh. 2, 6 2 fMfcg|5:x-y k 3A~ 

3D K 4A-4D "TfcglLx-y 

k 5 llSiar7h, 6 BB»a^.y K 10. 

63 CPU. 11 SBH. 12. 14 HU 

B, 13. 16. 61, 62. 6 5 y^M. 15- 

-WHR&i. 17 v-'JTJl^'X. 30, 3 0A. 3 

0B t-hv|->, 31. 31A. 31B MoNg 

t, 32, 32 A, 32 B MCG. 
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ram 
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ram 
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5' 
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[04] 

\ 102.104,106.108,110 



1 inear 
actuator 



[05] 







read struct 




^ ^SP3 




length out 




angle out 








1 





£ end y^SP6 



]5 ^l^fUlC^aCPUO^J^HI 
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Hind Leg 
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m cs go un ts 
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4A(4B) 



~~j Q^v^3C(3D) 



06 /<-^1rAra.-Hy h©*»ttC»-r5**Wa* 
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[012] 

[19 ] 




0 9 &2mm\~£Zv#V\-<Dlgt&,#its.m& 
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